perm filename EX2.SAI[0,BGB] blob sn#115074 filedate 1974-08-30 generic text, type C, neo UTF8
COMMENT ⊗   VALID 00002 PAGES
C REC  PAGE   DESCRIPTION
C00001 00001
C00002 00002	BEGIN "EXAMPLE TWO"
C00005 ENDMK
C⊗;
BEGIN "EXAMPLE TWO"
	REQUIRE "GEOMES.HDR[GEM,HE]" SOURCE_FILE;
	DEFINE αα="COMMENT"; DEFINE π="3.1415927";
	INTEGER B1,B2,J1,J2,J3,J4,J5,J6,C1,CHR,I;


	MKUNIV;GEODPY;
	B1 ← INB3D("ARM[DAT,BGB]");	αα MODEL OF THE YELLOW ARM;
	B2 ← INB3D("TABLE[DAT,BGB]");	αα MODEL OF THE HAND/EYE TABLE;
	J1 ← FDNAME("JOINT1");		αα SHOULDER - ABOUT VERTICAL;
	J2 ← FDNAME("JOINT2");		αα ARM - ABOUT HORIZONTAL;
	J3 ← FDNAME("JOINT3");		αα SLIDE;
	J4 ← FDNAME("JOINT4");		αα WRIST TWIST;
	J5 ← FDNAME("JOINT5");		αα WRIST FLAP;
	J6 ← FDNAME("JOINT6");		αα HAND;
	C1 ← INCAM("ARMCAM[DAT,BGB]");

FOR I←1 STEP 1 UNTIL 24 DO
BEGIN
	SHOW2(0,0);
	PLOTO("PLTX2."&CVS(I));
	ROTATE(-J1,0,0,π/40);
	ROTATE(-J2,0,0,-π/80);
	TRANSL(-J3,0,0,0.06);
END;
END "EXAMPLE TWO";